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ABSTRACT 


With the increased demands for higher productivity in industry and the military, 
control of Robot Manipulators with flexible joints is needed. The difficulties associated 
with the control of flexible joint robots include the following: (1) Nonlinearity of the 
arm motion (2) Coupled large motion (motion of the motor) and small motion (me- 
chanical vibration) and (3) measurements of feedback signals. This theis presents an 
controller designed to handle the difficulties related to flexible joint robots. The third 
joint of the PUMA 560 Robot was selected as an example. A control algorithm for 
flexible-body control was devised and an observer was designed with the use of 
MATRIX, to control tip motion of the single-link single-joint system. Computer simu- 
lation results are discussed, and a comparison between rigid-body controllers and the 


flexible-bodvy control is conducted. 
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I. INTRODUCTION 


A. ROBOT MANIPULATOR USES 
There is an increasing trend within the United States Navy towards applications that 
utilizes robots to perform tasks which are considered routine or dangerous for humans 


to perform. These tasks include: 
1. Under-water research and exploration 
2. Fire fighting 
3. Battle field logistic vehicle 
4. Perimeter patrol 
5 


Under-water autonomous vehicie 


Robotic submersibles are being studied and tested to be used to explore areas of the 
oceans that are presently too hazardous for man to explore. There is also a large po- 
tential for the use of robots in space. 

All the applications listed require close-loop automatic control that typically lead 
to manpower reductions, improvements in stability and response. 

In addition, the robotic manipulators currently installed in industrv also have the 
potential for improvement in the areas of increase accuracy, performance, as well as 
weight to load capacity and productivity. The enhance performance must come with a 
realized savings in cost and reduction both in energy consumption and overall physical 


plant size. 


B. BACKGROUND 
Most work in the past have centered on rigid body manipulators until recently when 


flexible body manipulators began to show great potential in industry. 


Control svstems for industrial robots are currently designed using mathematical 
models in which the links and drive trains are assumed to be rigid [Ref. 1: p. 196]. The 
jOint positions are controlled independently, using position and velocity feedback from 
sensors located at the joint actuators. 

However, improvements in dynamic response and payload to weight ratio require 
that the flexibility effects be taken into account in the modeling stage and incorporated 
into the controller design. Preliminary results of studies of link structural flexibility 
versus drive train compliance for several industrial robots, indicated that structural 
flexibility accounts for 2 - 20% of total arm compliance. If the structural flexibility of 
the arm is small relative to the drive train flexibility, then the arm could be represented 
by a rigid body model with “compliance lumped between the actuators and links.” 
PRS Use LSI) 

Drive train flexibilitv plays a critical role in robot motion control design. It has been 
shown that closed loop speed response of the manipulator can be increased beyond 
tvpical industrial practices bv considering the drive train compliance in the design and 
providing suitable feedback measurement [Ref. 1: p. 197]. Using a lumped parameter 
model, Forrest-Barlach and Babcock [Ref. 1: pp. 196-197] studied the effects of drive 
train compliance and actuator dynamics by modeling a two DOF manipulator and de- 
signing a position controller based on inverse dynamics. Simulation of various control- 
lers were performed utilizing the Advance Continuous Simulation Language. Their 
inverse dynamics control law is based on the concept of “computed torque.” This 
method decouples the motion of the arm when drive train compliance and actuator dy- 
namics are considered. The “computed torques” concepts are utilized to determine the 
required input torques as functions of jerk rate, jerk, acceleration, velocity and position 
errors. Jerk rate is a fourth ordered term. The ITAE performance criteria for pole 


placement is used to minimize the error between the desired and the actual state 


measurements [Ref. 1: p. 200]. They concluded that in general after comparative 
simulations, the inverse dynamics controller performance was superior to that of the 
other controllers they tested due to its ability to decouple the arm motion 
(Ref. 1: pp. 200-203]. 

The simulation study was conducted without considering practical limits on avail- 
able motor torques. Forrest-Barlach and Babcock concluded, limitation in available 
torques Will significantly affect system response. Therefore Forrest-Barlach and Babcock 
felt the effect of torque limiting on the relative performance of the controllers should be 
evaluated by selecting appropriate torque limits for the specific motors. 
[Ref. 1: pp. 203-204] 

In another study, Marino and Spong [Ref. 2: p. 1030] found joint elasticity is the 
dominant source of compliance in most current manipulator designs. This joint flexi- 
bility mav arise from gears, belts, links, bearings, and hvdraulic lines and limit speed and 
dynamic accuracy achievable by control algorithms designed assuming perfect rigidity 
at the joints. The nonlinear control problem using a single link manipulator with joint 
elasticity were studied. 

In their work, two nonlinear control techniques to control the manipulator: (1) 
feedback linearization design and (2) composite control design were used. It was found 
that feedback linearizing control required full state measurements which in their case 
included the velocities of both the link and the motor shaft. Whenever part of the state 
was not accessible for measurements, problems were created. [Ref. 2: pp.1031-1035] 

Based on extensive analytical and experimental studies by Sweet and Good 
[Ref. 3: pp. 724-727], realistic robot dynamic models have been presented which has 
been validated over the frequency range from 0 to 50 Hz. These models exhibit a strong 
influence of drive train flexibility, producing lightly damped poles in the neighborhood 


of § Hz, 14 Hz, and 40 Hz, all unmodeled by the conventional rigid body multiple link 


robot dynamic approach. Thev also noted the significance of drive train and mechanical 
flexibility had been recognized in only a few prior papers. One approach they used to 
improve robot motion control performance was to decouple the dvnamics of the robot 
links through nonlinear control. The decoupling action performed by the controller was 
particularly significant in the same frequency range where resonant behavior occurs 
which was present in the robot motion control loop of electro-mechanical drives with 
flexibility in series with the load. Sweet and Good also realized the existence of drive 
train interactions did not dismiss the idea of using nonlinear or decoupling control 
Strategies, but 1t required the use of realistic drive train models in the development of 
usable algonthms. Also they found high gear ratios employed in most drive units causes 
the torques resulting from cross-coupling effects as reflected back to the motors to be 
minimal [Ref. 3: pp. 725-726]. 

In a separate design study, Spong [Ref. 4: p. 312] investigated a second method of 
approach to control elastic joint manipulators. The second method 1s based on the “in- 
tegral manifold formulation” of the equation of motion. One advantage of this approach 
as noted by Spong, is it can be applied when onlv the link position and velocity are 
available for feedback. Spong concluded at the end of his evaluation that by using 
global feedback linearization, the nonlinearities in the system do not have to be com- 
puted exactly but rather once the proper coordinates are found in which to represent the 
system, the so called matching conditions can be satisfied. In other words the nonline- 
arities are all in the range space of the input. He further realized realistic limitations on 
motor torques can prevent the arm from reaching velocities of sufficient magnitude for 
cross-coupling terms to become significant, but realistic trajectories for robot arms in 
actual manufacturing applications rarelv require extremes of velocity and acceleration 
[Ref. 4: p. 310]. He finally concluded the integral manifold based corrective control 


method needed further investigation [Ref. 4: pp. 314-318]. 


The objectives of the above work have been the study of the nonlinear control 
problem for a robot manipulator with joint elasticity. Much of the past research in 
robotics modeled the robot manipulator as a rigid joint and did not consider joint 
elasticity. But recent studies have found joint elasticity is the dominant source of com- 
pliance in most current manipulator designs. It was their intention to illustrate several 
nonlinear control techniques to solve this control problem of joint elasticity. Their re- 
search provides the background for the investigation of a computed torque controller 
structure which considers drive train flexibility of a single link manipulator. 

In this work, the computed torque controller will be enhanced and evaluated. The 
“computed torque” concept requires the values of the second and third derivatives. Since 
these values can not be measured from the plant, an observer or estimator will be de- 


signed as part of the controller to provide the estimates of these unmeasurable values. 


C. METHOD 

The flexible manipulator offers low power consuniption, ease of transportation, re- 
duced material requirement, lower mounting strength and rigidity requirement, and 
lower overall cost [Ref. 5]. To meet the needs of a light-weight manipulator having 
greater performance capabilities, certain problems must be solved in order to fully utilize 
the flexible manipulator. 

The model must adequately describe the system and yet it must be simple enough 
to implement in order to design an adequate controller for the computation purpose. 

The controller in this thesis is designed by using the technique called the inverse 
dynamics control law based on the concept of “computed torque”. This control ap- 
proach represents a method of decoupling the arm motion when drive train comphiance 
and actuator dvnamics are considered. A single revolute joint was modeled for this re- 


search. [Ref. 1: pp. 196-197] 


First the plant will be discussed in Chapter III and the controller design procedure 
will be developed in Chapter IV. The parameters of the third flexible joint of the Puma 
560 Robot was used in the design procedures (Figure 1). A rigid body controller 1s 
currently installed in the control loop of the Puma 560 robot. A description of the Puma 
560 Robot is found in Appendix B. [Ref. 6: p. 1-27] 

The MATRIX,! computer software was used for the modeling of the controller and 
the plant and the software was installed on the Vax computer system. MATRIX, is a 
software package for modeling, simulation, engineering analvsis, control design and 


system identification. A description of MATRIX, can be found in Appendix A. 


I MATRIX, is a trademark of Integrated Systems Incorporated. 
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Figure 1. Joint 3 PUMA Robot Arm 


Il. PROBLEM STATEMENT 


A. INTENTIONS 

In the design of robot manipulators, controlling the tip position is of major concern. 
The end effector (robot tool) is attached to the tip position and through it performs the 
function of the robot arm. The second consideration is the small oscillation (small mo- 
tion) between the arm position and the motor position. 

Figure 2 shows a single-link manipulator with joint flexibility, consisting of an 
actuator (DC motor), a transmission line, and a rigid single link. The transmission line 
includes a flexible helical spring coupling and the indicated gears. The transmission 
line’s flexibility is the cause of the difference between arm position and motor position. 

It is the intent of this research to design a controller which can accurately control 
the tip position and also account for and minimize the small oscillation (small motion) 


of the system. 


B. PROCEDURE 

This research 1s conducted in three phases. 

First, using Lagrangian dynamics approach, a mathematical model of the flexible- 
body model plant is derived. Next the flexible-body controller is designed using the 
concept of control law along with designing a state observer. 

Second, considering the special case of rigid-body control, a comparison between the 
two methods of feedback, motor feedback and arm feedback, 1s conducted with the best 
method of feedback control selected to continue comparison test and analysis. 

Third, after determining that the past method of control could be improved on by 


a flexible-body controller, comparison tests are conducted between the selected 





Figure 2. Single-Link Manipulator with Joint Flexibility 


rigid-body controller and the flexible-body controller. A determination is made at the 
end to show how much the flexible-body controller improves plant operation. 
Flexibility of the gear train will be considered in this research work but gear back- 
lash will be neglected for now. Various simulation runs will be conducted with various 
parameters to study the dynamic flexibility behavior of the control system. An investi- 
gation of the special case of a rigid-body controller controlling a flexible body plant will 


be observed and compared with the simulation results of the flexible-body controller. 


Il. PLANT MODELING 


A. EQUATIONS FOR PLANT 
1. Flexible Body Model 

Due to its systematic approach, the Lagrangian dynamics approach is used to 
derive the equations of motion. The total kinetic energy is comprised of the individual 
kinetic energies of the link, actuator, and any applied forces. The total potential energy 
of the system 1s comprised of the elastic strain energy of the link and the potential energv 
due to gravity. Generalized forces are made up of any applied forces and damping 
forces. Through mathematical manipulations and simplifications, two sets of coupled 
non-linear equations are derived. [Ref. 7: pp. 239-254] 

Consider a single revolute joint (Figure 2), consisting of an actuator (DC mo- 
tor) whose rotor inertia J, 1s connected through a transmission link to a ngid link with 
inertia J, about the axis of rotation. The transmission line consist of a flexible helical 
spring coupling and the gears shown. The transmission line has a spring with stiffness 


k and the gear ratio 1s equal to G,. 


Angle in Motor Side 


’ ~ Angle in Arm Side 


The generalized coordinates includes the link angle @, and the motor shaft angle @, . 
The following relationships will apply in the derivation of the plant model: 


6G, — 6, = 6 (deflection) (3.1) 


Since the motion of the link 1s a pure rotation about the motor axis, the kinetic 


and potential energies are: 


l 


P 7 1 “9 Jl 9 
(KE) a aa Ope (3.2) 


(PE) = + k(0,G, - O,)° + meg (1 — sin ,) (3.3) 


. be ; 
Where m, is the total mass of the arm (link) and zs the distance from the axis of ro- 
tation to the center of mass of the arm. 


The equations of motion are found from the Lagrangian method to be: 
Jaba + K(O{G, — On) + Mag cos 0, =0 (3.4) 


JnOm ~ kK(@,G, — 9,) = T (3.5) 


Where T is a generalized force applied to the transmission line through the actuator. 
[Ref 7: pp. 259-261] 
See Figure 3 for a block diagram of the Flexible Body model plant. 
2. Rigid Body Model 
For the special case of a rigid body model, the following assumptions are made 


(refer to Equations 3.2 and 3.3) [Ref. 2: p. 1030]: 
1K - © 


2. The elastic displacement 0, — @, —- 0 


Therefore the kinetic and potential energies equations for the rigid body case 


reduces to: 


KE 


] - 
(Ja + In)07 


(3.6) 
PE 


2 
mg > (1 — sin 6,) 
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Referring back to Equations (3.3) and (3.4), The Lagrange equations reduces to: 
J, + Indi, + meg COS 6 =r 3.7) 


The only nonlinearity term, cos @,, appears in Equations (3.4) and (3.7). 


B. ADDED MASS AND DAMPING 
The additional special case of added mass and damping can be modeled into the 
plant by adding the appropriate terms to Equations (3.4), (3.5), and (3.7) (see Appendix 
C for an explanation and derivation of the added mass and dampening equations). 
With the model of the plant, a controller for the flexible joint plant is designed as 
well as a a special case where the joint is considered rigid. A rigid body controller 1s 
designed to test its ability to control a plant with flexibility effects present. The design 


of the controller will be discussed in Chapter IV. 


IV. CONTROLLER DESIGN 


A. CONTROL LAW 
I. Derivation 
The controller is designed using the following steps [Ref. I: p. 200}: 
The dynamic equation of motion, equation (3.4), can be solved for the motor 
position in terms of the arm position: 
( m,¢/ 


6, = 6,G,+J,— + 


ay San G.. (4.1) 


Next differentiating Equation (4.1) twice with respect to time yields the following: 








7 mg! a mg! ae 1,6, 
0,, = |G, - sin 6, |6, — CRGOS.0 (4.2) 





where 





mg! . ise 2 
Fel (6, — BE sin 6. )b = 6? cond, | + 1+ mse 0088 (4.4) 


See Figure 4 for the block diagram of the F equation. Equation (4.3) 1s a fourth order 


differential equation in terms of the arm variables alone. 
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Next, the concept of computed torque is utilized to determine the desired input 
torques as a function of the fourth and third derivatives, acceleration, velocity, and po- 
sition errors. The desired input torque can be written as: 

(i. See sh, 
Ty= 54 | 07+ K3(04— 6) + Ky(8,— 8) + K,(8,— 8) 


k (4.5) 
Ge Oe 


where the K's are constants representing state error feedback gains. Assuming the non- 
linear F equation terms can be computed based on plant dynamics and the availability 


of measurements, equating Equation (4.3) and Equation (4.5) together results in: 





ae | (8 — 84) + K3(6 — 64) + K,(6 — 64) + K, (8 — 64) 46) 
+ Ky(6 — 0,)J =0 
Since J,, J,, and & are non zero, Equation (4.6) becomes: 
€ + K3e + Kye + Kyé + Kye = 0 (4.7) 
where 
éo—(@ —— ¢,) 
is the position error. As time — oo , the steady state position § error 


e = (9 — @,) > O (note this is true for specific K’s obtained using the ITAE perform- 
ance criteria) [Ref. 1: pp. 200-201}. 
ITAE performance criteria for a fourth order equation is used for the selection 


of the K values. The values are: 


K; = 2G, 


K, = 3.40 

; (4.8) 
K, = 2./7w,, 
K, = 1.0w, 


w, represents the selected servo input speed to the system. [Ref. 8: pp. 129-130] 
A block diagram of the Flexible Body Controller is shown in Figure 5. 
2. Special Case of Rigid Body Model 
Referring back to equation (3.7), one can see a controller for the Rigid Body 
case can be developed along the same lines. Define the desired input torque equation 


aoe 
Tz = Im + Ja)@g + K(0; — 6) + K,(0, — 0) + F (4.9) 
where 
—— mag 60s 6 (4.10) 


Equating equations (3.7) and (4.9) together and dividing out the non zero terms, the 


following results: 
epee ea let (4.11) 


To let this steady state error approach zero, K,and K, should be properlv chosen. A 
block diagram of the Rigid Body Controller 1s shown in Figure 6. See Figure 7 for a 


block diagram of the Rigid Body Model F equation. 
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B. OBSERVER DESIGN 

Referring back to equation (4.6), this external feedback linearization series requires 
the values of the second and third derivatives. These values are not measurable or 
available from the plant. 

Often it is not possible to achieve acceptable performance using only those state 
variables that can be measured. If the system is observable, it is possible to estimate 
those state variables that are not directly accessible to measurements using measuring 
data from those that are measurable. 

State variable estimates may in some circumstances be even preferable to direct 
measurements, because the errors produced by the instruments that provide the meas- 
urements mav be larger than errors in estimating these variables. [Ref. 9: p.259] 

A dynamic system whose variables are known can be estimated with the use of an 
observer. Luenberger [Ref. 9: pp. 260-216] showed, that for any observable linear svs- 
tem, an observer can be designed having the property that the estimation error (the dif- 
ference between the state variables of the actual system and the variables of the 
observer) can be made to go to zero as fast as one wants. 

A state observer is designed to estimate the values of @ and @. The observer is 
shown in Figure 8 and in Figure 9, 

A mathematical derivation of the observer used in this research is presented in Ap- 


pendix D. 
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V. EVALUATIONS 


After designing the flexible-body controller and reviewing the special case of the 
rigid-body controller, a comparison will be conducted between the two controllers. The 
comparison will be focused on responding speed, payload capacity and torque require- 
ment. The first set of comparisons will be between the two methods of feedback for 
rigid-body control (arm feedback and motor feedback). The second set of comparisons 
will be between the rigid-body control (using the best method of feedback) and flexible- 


body control. 


A. RIGID-BODY CONTROL 

Simulations were conducted for the special case of the Rigid-Body Controller in or- 
der to investigate its performance characteristics. The controller was used to control a 
plant with joint flexibility. The parameters used in the simulation were from the third 


joint of the PUMA 560 Robot arm. 


m, = 4.8 kg 
J, = 0.086 kg —m? 
J,, = 0.83 kg — m’ 
k = 11650 Aa 
= 53.69 
= ().007 meter 
Lp = 0.439 meter 


Mp = 2.5kg 


For the Rigid-Body case, there are two methods of feedback, namely, feedback from 


the tip (arm) position and feedback from the motor position. To demonstrate and 


evaluate the ngid-bodv controller, both methods of feedback will be investigated. The 
servo input speeds used were w, = Landw, = 4. The following three outputs will be 


shown for each method and speed: 
I. Arm position 
2. Torque requirements 


3. Small motion differences 


Note, on the graph of small motion (the difference between the arm position and the 
motor position), the major line 1s the servo contro] mode which 1s the result of the entire 
system movement. The second part 1s the mechanical vibration superimposed onto the 
servo mode. 

1. Rigid Body withw, = | 

The graphs for arm feedback are shown in Figure 10, Figure 11, and in 
Figure 12. The graphs for the motor feedback are shown in Figure 13, Figure 14, and 
in Eveumneshs: 

As shown in Figure 10, an unacceptable long settling time occurred for arm 
feedback. The cycle time is longer also for the arm feedback case. In the motor feed- 
back case, the arm settles at the desired position of 5 radians after 7.4 seconds. Looking 
at Figure 12, and Figure 15, the servo control mode amplitude difference is similar be- 
tween the two cases but the mechanical vibration (spikes) 1s more pronounced for the 
arm feedback case. Looking at Figure 11 and Figure 14, the torque is 32 times lower 
for arm feedback than for motor feedback. The key point here 1s the motor feedback 
provides overall superior performances but at an high torque requirement. 

2. Rigid Body withw, = 4 
The servo input speed was increased to w, = 4 to further study the effects of 


increased speed on performance. The graphs for arm feedback are shown in Figure 16, 
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Figure 12. 
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Figure 13. 
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Rigid Body Model Motor feedBack (small motion) 


Figure 15. 
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Figure 17, and Figure 18. The graphs for the motor feedback are shown in Figure 19, 
Figure 20, Figure 21, and in Figure 22. 

As shown in Figure 16, the systems response time has increased, but after 40 
seconds it still has not settled out. The motor feedback settling time has decreased to 
1.9 seconds (Figure 19). Another area to look at is the increased in the level of small 
motion (Figure 21) and (Figure 18). The mechanical vibration has increased for both 
cases but the level is still less for the motor feedback configuration. The torque re- 
quirements for motor feedback case (Figure 20) has increased by a factor of 14. 

Appendix E presents additional simulation runs for the motor feedback config- 
uration. In each situation a step input with a desired final position of @, = 5 was used 
unless otherwise noted. 

Although the controller was designed via pole placement using coefficients 
based on ITAE performance criteria, in the comparison between the two ngid body 
cases, the motor feedback case obviously demonstrated the best performance character- 
istics based on rise time, settling time, servo control mode amplitude difference, me- 
chanical vibration and system respond time. The only weakness noted is in the area of 
torque requirements. The levels for the motor feedback configuration far exceeded the 
requirements for the arm feedback case ( by 32 times for w, = 1 and46 umes form, = 


4), The results of the rigid body comparisons are listed in Table 1 on page 41. 
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Figure 20. 
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Table 1. RIGID BODY MODEL COMPARISON 


ARM FEEDBACK MOTOR FEEDBACK 


Rise Time (seconds 
Sy a a a 
Maximum Torque (N-m) ee Sos 248.0 —_ 0 


Servo Control Mode Ampli- 
tude Absolute difference 0.0001 0.0002 0.0003 0.0004 
(radians) 
Mechanical Vibration (major 
0.008 0.018 0.0010 0.0019 


peak to peak average) 
eee 


(radians) 
* Note the graph had not settled out by the end of the simulation run. 

















While the motor feedback case seems promising, there still is a need for im- 


provements in the areas of: 
1. Lower Torque Requirements 
2. Less Mechanical Vibrations 
3. Lower Servo Mode Small Motion Differences 


4. Less Mechanical Electric wear on actuator 


Therefore the flexible-body control will be compared against the rigid-body 
control using motor feedback to determine if there is an improvement in performance 
characteristics. Due to the fact the Flexible-Body 1s a fourth order controller, the servo 
speed input will be run slightly higher in order to make realistic comparisons. A point 
to point and trajectory tracking control scheme were used. Added mass was analyzed 


in the simulations also. 


4] 


B. FLEXIBLE-BODY CONTROLLER 
1. Point to Point Control - No Load 

The graphs for motor feedback are shown in Figure 13, Figure 14, and 
Figure 15. The graphs for the flexible body controller are shown in Figure 23, 
Figure 24, and Figure 25. 

Reviewing the flexible-body graphs and the rigid-body graphs, the flexible-body 
controller provides improvements 1n all characteristic areas with a decrease in required 
torque. All this occurs with the flexible-body controller moving at a faster servo input 
speed. Other than one large spike at 0.8 seconds, the flexible-body model exhibited 6 
times less mechanical vibration. The servo control mode amplitude difference was sim- 
ilar between the two cases. With an increase in input servo speed, the servo control 
mode amplitude difference and mechanical vibrations increased as expected. 

The second simulation analyzed the effect of increased servo input speed on the 
performance characteristics of the two controllers. As seen in Table 2 on page 46, the 
flexible-body controller still requires less torque, generates less mechanical vibration and 
has a steeper slope than the rigid-body controller. The steeper slope equates to a more 
responsive svstem. The servo control mode amplitude difference was also lower than the 


rigid-bodv model. The graphs of these simulation runs are in Appendix E. 
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Figure 25. 
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Table 2. FLEXIBLE BODY VS RIGID BODY MODEL - NO LOAD 


Flexible Body Model Rigid Body Model 
wn= Pi - wn = A Wwh= 2 
C= tN = 


Rise Time (seconds) ra 
Settling Time (seconds) rae a 
Maximum Torque (N-m) Z27.0 870.0 248.0 


Servo Control] Mode Ampli- 
tude Absolute difference 0.0003 0.0003 0.0003 0.0003 
(radians) 


Mechanical Vibration (major 
peak to peak average) 0.0005 0.0005 0.0010 0.0015 
(radians) 


Slope (Speed) (rad s) 





2. Load and Speed Considerations 

Since the main purpose for studying a controller is to determine if it can perform 
its designed tasks, a comparison of two different loads (1.36 kg and 2.5 kg) and various 
speeds were investigated in order to study the difference in capabilities between the two 
methods or control. Again since the flexible-bodv is a fourth order controller, the servo 
input speed was ran shghtlv higher in order to allow more realistic comparisons. The 
comparable speeds used were wm, = 1 and w, = 3 for rigid-body control and w, = 2 
and w, = 4 for flexible-body control. The graphs of the robot arm positions can be 
seen in Figure 26 through Figure 33. 

As can be seen in Table 3 on page 55 and Table 4 on page 56, as the load in- 
creases, the torque requirements has increase by a factor of 8 (from 312 N-m to 2505 
N-m for 1.36 kg and 370 N-m to 2900 N-m for 2.5 kg) for the ngid-body model but the 
flexible-body model experienced only an increase of a factor of 3.8 (from 231 N-m to 900 


N-m for 1.36 kg and 238 N-m to 900 N-m for 2.5 kg). The servo control mode amplitude 
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Figure 26. 
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difference has increase by 2.5 for the rigid body model but only by 1.8 for the flexible- 
body controller for the same load change. The rigid-bodvy controller experienced more 
mechanical vibration as can be seen in Table 3 on page 55 and Table 4 on page 56. 
Also the rise time has slowed down for the rigid-body controller as the load increases. 
As the servo speed input increases, the rigid-body control experience higher torque re- 
quirement changes, higher level of mechanical vibration and larger servo control mode 
amplitude differences. The flexible-body control requires less torque, experience less 
mechanical vibration and smaller servo contro] mode amplitude for a comparable speed 
increase. The rise time is quicker for flexible-bodv control for a comparable increase in 


servo input speed. 


Table 3. FLEXIBLE BODY VS RIGID BODY MODEL - 1.36 KG 


Flexible Body Model Rigid Body Model 


Ee pg 4 ae wn=3 
ie = 
01 a 01 y 0] 0.01 
Rise Time (seconds) a ee 


Settling Time (seconds) a 
Maximum Torque (\-m) 


Servo Contro! Mode Ampli- 
tude Absolute difference 0.0037 0.0068 0.0025 0.0062 
(radians) 


Mechanical Vibration (major 
peak to peak average) 0.0015 0.0015 0.0015 0.0045 
(radians) 


_ ACE 
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Table 4. FLEXIBLE BODY VS RIGID BODY MODEL - 2.5 KG 


Fiexible Body Model Rigid Body Model 
y 2 a 4 gh J ad 3 
*o. 01 o 01 7) 01 or 01 
Rise Time (seconds) | 23. | 14] 40 ~~) 4s 


Settling Time (second) | 55 [| 28 {| 60 | 40 
Maximum Torque (N-m) 238.0 900.0 370.0 2900.0 


Servo Control Mode Amph- 
tude Absolute difference 0.0050 0.0090 0.0034 0.0080 
(radians) 
Mechanical Vibration (major 
peak to peak average) 0.0020 0.0025 0.0028 0.0070 
(radians) 


Slope (Speed) (rads) | 2.20454] 25 3.33 













The mass increase had little effect on the performance of the flexible-body con- 
troller but the rigid-body controller stability has decrease. The robot arm position 
graphs for the rigid-bodv case exhibit little or no overshoot as required by the ITAE 
criteria used to design the controller. The mechanical vibration of the rigid-body contro] 
system has increased also for both a speed increase as Well as a mass increase. 

From the stand point of desirability, the flexible-body controller moves the 
added mass faster with less vibration or system wear, and with less torque. The 
flexible-body controller still continues to demonstrate superior performance character- 
istics even with a load placed at the tip position and a comparable speed increase. 

The torque and small motion graphs can be viewed in Appendix E. 

As shown by the graphs, the flexible-body controller again outperformed the 
rigid-body controller. The flexible-body controller requires less torque to move the 


added mass and does it at a faster speed. The mechanical vibration is less for the 
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Flexible-Body case even though the servo control mode difference is similar between the 
two controllers. 
3. Trajectory Motion 

The next simulation involved a trajectory tracking with and without an added 
mass. The trajectory tracking was a combination of a steady ramp input with a leveling 
off at 4 seconds and a desired arm position of five radians. Next, after holding the input 
at a constant value in order to maintain an arm position of five radians, a negative ramp 
input at 10.5 seconds was used to bring the arm back to its starting position at approx- 
imately 16 seconds. The results of the simulation are listed in Table 5. The graphs of 
the robot arm motion can be seen in Figure 34 through Figure 37. The other graphs 


are in Appendix E. 










Table 5. FLEXIBLE BODY VS RIGID BODY MODEL - TRAJECTORY 
added mass 


Flexible Body Model Rigid Body Mode! 
2.5 ke 


Desired Rise Time (seconds) | 40 | 40 | 40 | 40 
Settling Time (seconds) * 
Maximum Torque (N-m) Sear Cini 98.00 140.0 


Servo Control Mode Ampli- 
tude Absolute difference 0.00029 0.0026 0.0004 0.0080 
(radians) 
Mechanical Vibration (major 
peak to peak average) 0.00020 0.00060 0.0010 0.0050 
(radians) 


Desired Slope (Speed) (rad 9 


* For the level portion of the trajectory between the two ramps =n 










As seen in Figure 34 through Figure 37, there is a more pronouned overshoot 


than found on the point to point control. This is due to the momentum left over in the 
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system as it reaches the desired position. It overshoots the position and gradually settles 
down to the final position. Due to the fact the controller gradually rises the arm to its 
desired position instead of a sudden jump similar to point to point control, less torque 
is required to perform the same movement. As a result less mechanical vibration is de- 
tected and the servo control mode amplitude is less. The desired trajectory was designed 
to lower the speed response to the desired trajectory at the saving of wear and tear on 
the equipment. With less torque required, this tracking method would consume less 
energy. The flexible-body controller still was able to outperform the rigid-body con- 
troller. With an increase in load, the flexible-bodv control servo control mode amplitude 
was less than the rigid-bodv control experiencing the same load increases. Also the 
mechanical vibration and the torque requirements were less for the flexible-body control. 
But even still the trajectory tracking allows larger masses to be handled at a lower re- 
quired torque than do the point to point control method. For comparable speed in- 
creases, similar results were obtained. The level of mechanical vibration and the servo 
contro] mode amplitude were greater for the nigid-body control. The torque require- 
ments were also greater for the rigid-body control. The the relative stability were similar 
for both the flexible-body and rigid-body control. 

Overall observation is the trajectory tracking required less torque to move a 
mass than the point to point control required to move the arm with no mass attached. 
Also the loaded condition reached a relative stability condition faster than the unloaded 
case. An increase in load from 0 kg to 2.5 kg and comparable increases in servo input 
speeds resulted in an increase in the mechanical vibration and servo control mode am- 
plitude for both controllers, with the rigid-body controller level of vibration being 
slightly higher than the flexible-body controller. But the overall level of mechanical vi- 


bration and servo control mode amplitude difference for the trajectory tracking method 


is less than the vibration level and servo control mode amplitude difference for the point 


to point control method. 


C. TORQUE SATURATION CONSIDERATIONS 

The simulation analysis up to this point has not considered an input torque limita- 
tion on the motor for the actuator. Since the PUMA Robot arm is used as the model 
for this research work, the limitation of the model should be included in the analysis of 
the flexible body controller. The PUMA Robot arm was designed as a rigid body device 
which restricts any flexibility in its operation. 

A Saturation device was included in the design in order to study the performance 
characteristics of the controller controlling the PUMA Robot arm. A value of 49.2 
newton-meters was used as the torque saturation point (49.2 newton-meters is the 
torque limit of the third joint motor on the PUMA arm). 

First the performance of the Rigid Body case will be looked at and finally the Flex- 
ible Body case will be reviewed. 

1. Rigid Body Saturation Case 

For the graphs of the Rigid Bodv case with saturation included, see Figure 38 
for point to point control and Figure 39 and Figure 40 for trajectory control. For the 
Rigid Body case, when the the torque value exceeded the preset limit of 49.2 newton- 
meters, the curve flattened out until the torque decreased below the preset limit. The 
servo control mode amplitude and the mechanical vibration results are similar to the 
cases without torque limitation included. The rise time for the saturation case 1s slower 
and the settling time is longer. For a summary of the rigid body simulations see 


Table 6 on page 67. 
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Table 6. RIGID BODY TORQUE LIMITATION RESULTS 


Point to Point Trajectory Trajectory 
Tracking Con- | Tracking Con- | Tracking Con- 
trol trol 


wn= | 


Maximum Torque (N-m) 


Servo Control Mode Ampli- 
tude Absolute difference 0.0003 0.0004 0.003 
(radians) 


Mechanical Vibration (major 
peak to peak average) 
(radians) 


Maximum Overshoot 
(radians) 





2. Flexible Body Saturation Case 

For graphs of the flexible body case with saturation included, see Figure 41 and 
Figure 42 for point to point control and Figure 43 for trajectory control. 

For the point to point control with input servo speed of w, = 2, the torque 
curve had a secondarv frequency mode superimposed on it during the time input torque 
exceeded the imposed limit. This was present only at w, greater than one. Overshoot 
of the final desired position was higher for the saturation cases. This was due to the 
momentum which was still present in the system after the torque limitation was reached. 
The servo control mode amplitude differences are similar to the non saturation cases but 
the mechanical vibration was higher for the torque saturation cases. Using the trajec- 
tory tracking method with added mass (Figure 43), the controller was still able to move 
the mass to the desired arm position but at a reduced level of performance when com- 


pared to the case where motor torque limitations are not considered. 
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The Flexible-Body controller was still able to control the plant at a greater per- 
formance level than the Rigid-Bodv controller in the areas of less mechanical vibration, 
smaller servo mode amplitude differences and quicker settling times, but its performance 
was degraded due to the limitation of the torque motor input. For a summary of flexible 


bodv model simulations see Table 7. 


Table 7. FLEXIBLE BODY TORQUE LIMITATION RESULTS 












Point to Point Trajectory Trajectory 
Tracking Con- | Tracking Con- | Tracking Con- 
trol trol trol 










Vaximum Torque (cm 


Servo Control Mode Ampli- 
tude Absolute difference 0.0003 0.0003 0.0034 
(radians) 


Mechanical Vibration (major 


peak to peak average) 0.0005 0.0008 0.0020 
(radians) 


J vers - 
Maximum O ershoot 58 6.02 
(radians) 








D. DISCUSSION 
1. Rigid Body Results 
The performance of the motor feedback method of control remains superior to 
the arm feedback method for all servo bandwidths. With its long settling time, the arm 
feedback is unacceptable as a method of control. This poor performance is due to the 
fact the sensors and actuators used for control are separated bv the flexible structure of 
the transmission line and gears. The flexibility of the system introduces noise in the 


feedback loop which in turn produces erroneous or inaccurate signals to be received by 


aA 


the controller. The motor feedback, on the other hand, is not faced with this predica- 
ment. Its sensor and actuator are located together and is not faced with this unwanted 
disturbance or noise. 

Another key point are the two parts of the small motion (the difference between 
the arm position and the motor position) graph. The major line is the servo control 
mode which is the result of the entire system movement. The second part is the me- 
chanical vibration superimposed onto the servo mode. As the servo input frequency is 
increased, the servo mode motion increased with a slight increase in mechanical vi- 
bration. This is due to the fact the servo frequency w, moves towards the svstems na- 
tural frequency w, When damping is introduced, the mechanical vibration decreases 
slightly while the servo mode increases. With the addition of ¢ , the system’s natural 
frequency decreases to w,. With this decrease in natural frequency which relates to a 
movement towards the servo input frequency, the excitation of the svstem increases due 
to this closer position of w, to @,,. 

2. Flexible Body Results 

The Flexible Body Model has demonstrated improved characteristics in each of 
the areas which were measured. One superior quality was the ability of the controller 
to move at a faster rate vet use less torque while the Rigid Body controller required more 
torque while moving at a slower speed. This means the Flexible controller has the ca- 
pability to control greater payloads, provide more accuracy and could possibly consume 
less energy. The results of the simulations are listed in the tables on the pages to follow. 
The results of the Rigid Body Model comparison is listed in Table 1 on page 41 below. 
To see the Flexible Bodv Model vs Rigid Body Model results see Table 2 on page 46. 
To review the effects of damping on the Rigid Body and Flexible Body Model both with 


input speed increases and added mass increases see Table 3 on page 55 and Table 4 on 


page 56. To see the results of trajectory tracking effects on the Flexible Body Model and 
Rigid Body Model see Table 5 on page 57. 
3. Saturation Case Results 

For the cases where torque saturation was considered, the Flexible Body con- 
troller performance characteristics deteriorated as the result of the limitation of the ri- 
gidity of the PLMA Robot arm. The level of mechanical vibration increased and the 
servo mode level increased also. At an input servo speed of w, greater than one, sec- 
ondary frequencies of the servo system were superimposed on the torque curves where 
the level exceeded the preset torque limit (since the Flexible Body controller is a fourth 
order equation, 1s has an additional frequency mode which is not present in the Rigid 
Body controller). For the added mass case, the flexible body controller was still able to 
control the plant. The performance characteristic were superior to the Rigid Body con- 
troller in the areas of less mechanical vibration, smaller servo control mode amplitude 
differences and quicker settling times. However, the performance of the controller was 
still degraded. The controller needs to operate with a plant designed with flexibility. 
The PUMA plant is designed to be a rigid plant and therefore restricts the capability of 
the flexible body controller. The controller stability has decreased as a result of this re- 
striction in motor torque. The results of saturation effects on the Rigid Body Model can 
be seen in Table 6 on page 67 and the results of the Flexible Body Mode experiencing 
torque limitation can be reviewed in in Table 7 on page 71. 

In Figure 44 is the Super Block diagram of the entire system of the Flexible 
Body Model. In Figure 45 is displaved the Super Block diagram of the Rigid Body 
Model system. 

Additional simulations were run at various input speeds, with and without 
damping. These runs without explanation can be reviewed in Appendix E. The graphs 


are self explanatory. The desired final position of 5 radians was used in all cases. 
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VI. CONCLUSIONS 


A. INSIGHTS 
The flexible-body controller performance was superior to the rigid body controller. 


The results of the comparisons between the two controllers are summarized as follows: 


1. With an increase in input servo speed, the rigid body had a higher Mechanical vi- 
bration level 


2. The flexible body model required less torque even at a higher input speeds 


3. The flexible body model proved to be a responsive robust system over the range 
of speeds and conditions tested 


4. The torque requirement for the added mass case was less for the flexible-body 
controller 


5. The flexible body model performance characteristics were superior to a rigid body 
for both an increase in load and speed 


6. A ramp input requires a lower torque requirement with no increase in servo mode 
or mechanical vibration 


7. The flexible-body controller using a ramp trajectory was able to handle a greater 
load with an improvement in all performance characteristics except rise time which 
increased slightly 


It appears the results obtained points towards selecting the flexible body controller. 
However, since the results are based on simulations, more comparisons should be con- 
ducted at more speeds and a variety of loads. This research considered the the flexibility 
in the gear coupling and neglected gear backlash. 

The case of the torque limitation did point out some of the limitations of the 
flexible-body controller. The performance characteristics deteriorated as the result of the 
limitation of available input servo torque. The level of mechanical vibration increased 
and the servo mode level increased also. At input servo speeds greater than w, = 1, 
secondary frequencies of the servo system were superimposed on the torque curve where 


the torque required exceeded the preset level. Results in the simulations indicate that 
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actuator saturation may be the only significant nonlinearity in the robot motion design 


problem. 


B. RECOMMENDATIONS 


The following recommendations are submitted: 


1. Continue further study of the Flexible Body Model under varies simulated condi- 
tions and load. 


2. Build a Flexible Body Controller and test it on the PUMA Robot. 
3. Extend the present study of the Flexible Manipulator to include more than one 
joint. 
Additional suggestions are: 


1. The flexible bodv controller be used at input speeds which do not exceed the satu- 
ration level or the actuator. 


2. The flexible body controller be tested on plants which were design to be flexible. 
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APPENDIX A. MATRIX, 


A. MATRIX, 

MATRIX, is a Computer Aided Engineering software package for modeling, simu- 
lation, engineering analysis, control design, signal pRocersine! and system identification. 

MATRIX, , is a programmable, matrix solving software package with emphasis on 
controls applications. Scalar functions as well as complex, large-scale matrix problems 
can be solved using the state-of-the art matrix analysis functions built into MATRIX, . 
MATRIX, can be used to solve complex, large-scale matrix problems in an engineering 
discipline. However, it is bested used in the analysis of control engineering related 
problems. MATRIX, was designed to have a complete set of design and analysis func- 
tions for input/output (classical) control and state-space (modern) control.” [Ref. 10] 

Control systems are concerned with the control of specific variables. The interre- 
lationship of the controlled variables to the controlling variables is required. This re- 
lationship is typically represented by the transfer function of the subsvstem relating the 
input and output variables. Therefore, the transfer function is an important relation for 
control engineering. The importance of the cause and effect relationship of the transfer 
function 1s evidence by representing the relationship of the system by use of diagrams 
called block diagrams. 

The block diagram representation of a system’s relationships is prevalent in control 
svstem engineering. Block diagrams consist of unidirectional, operational blocks that 
represent the transfer function of the variables of interest. Once the block diagram 1s 


developed, a transfer function relation is defined, and the system is analyzed using the 
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transfer function. MATRIX, has a feature called SYSTEM BUILD? which solves linear 


Or non-linear control problems directly from block diagrams. 


B. SYSTEM_BUILD 

SYSTEM_BUILD 1s an interactive,menu-driven graphical environment for building, 
modifving computer simulation models. Any combination of linear, non-linear, 
continuous-time or discrete-time models that describe a system can be constructed from 
a library of more that 70 distinct block types. Simulating system performance under 
both nominal and constrained environments is easily accomplished with 
SYSTEM_BUILD. [Ref. 1]: pp. SB P-1-SB P-2] 

Systems are modeled by dividing them into individual components, and each com- 
ponents 1s described by a specific type of functional block. A group of functional blocks 
are called Super Blocks, and Super Blocks can be nested together within another Super 
Block. Once a system is modeled in SYSTEM_BUILD, The svstem 1s analyzed in the 
MATRIX, interpreter. Any system modeled in SYSTEM BUILD can be simulated, 
linearized, and analyzed through the use integration algonthms, built into the 
MATRIX, interpreter, which are suitable for simulating a variety of systems. 


(Ref. 11: pp. SB P-1] 


2 SYSTEM_ BUILD is a trademark of Integrated Systems Incorporated. 
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APPENDIX B. PUMA 560 ROBOT DESCRIPTION 


The Puma 560 Robot is an industrial robot system with six degrees of freedom. It 
is comprised of a robot arm (Figure 46) [Ref. 6: p. 1-20], a controller, software, and 
other peripherals. It is designed to manipulate nominal end-effector load of 2.5 kilo- 
grams. With a positional repeatability of 0.1 milli-meters. It has a spherical work en- 
velope of 0.92 meters (Figure 47) [Ref. 6: p. 2-2]. Its drive is an electric DC servomotor. 
The maximum tool acceleration is | G with a maximum tool velocity of 1.0 meter per 
second (with maximum load within the primary work envelope). The maximum static 
force at the tool is 58 newtons. The arm assembly is driven by a permanent-magnet DC 
servomotor driving through its associated gear train. The motor contains an incremental 
encoder and a potentiometer driven through a 116 to | gear reduction. The motor is 
housed in the upper arm. The gear train is housed in the elbow end of the upper arm 
and is connected to the motor by a drive shaft. A bevel pinion on the input shaft drives 
a bevel gear on one end of an idler shaft. A spur pinion at the other end of the idler 
shaft engages a bull gear fixed to the forearm, and so rotates the forearm around the 
elbow axis. [Ref. 6: pp. 1-22-1-25] 

The PL MA 560 Robot 1s controlled by a closed-loop control system. Incremental 
encoders and potentiometers at each drive motor provide the positional feedback for the 
control system. Each of the joint encoders provides a resolution of approximately 0.005 
degree/bit . The PLMA 560 robot can also be positioned using transformations. 


UsSSlio 2] 


80 


SHOULDER 


UPPER ARM 
(INNER LINK) 


FOREARM ee. 
(OUTER LINK) OZ 
\y 


WRIST 
(Gripper not shown) 





Figure 46. PUMA60 Robot Arm 


8! 


WORKING ENVELOPE 


GENERATES 


(0.820 m RADIUS 
THIS LINE 


TO TOOL FLANGE) 












MIN. RADIUS SWEPT 
BY HAND CENTER-LINE 


BY HAND CENTER-LINE 
0.150 m (6.9 In.) 


MAX. RADIUS SWEPT 
0.432 m (17.0 In.) 


0.864 m (34.0 In.) 
RADIUS 





Envelope 
82 





Robot Arm Operating 


THIS REGION IS 
ATTAINABLE BY 
ROBOT IN LEFTY 
CONFIGURATION 


Figure 47. 


APPENDIX C. ADDED MASS AND DAMPING 


A. ADDED MASS EQUATIONS 
For added mass, the J, term is revised to include the additional mass which is placed 


at the arm tip position. The appropriate term is: 


M pL ng cos 4, (Gan) 


which is added to Equations (3.4) and (3.7). The following term ML} is added to the 
J, term which results in a new term J,7, which represents the moment of inertia for the 
link (arm) and the added mass (see Figure 48). 

Now performing the derivation for the controller as presented in Chapter Four with 


the additional added mass terms, the revised F equation (Equation 4.4) will be: 





m,gl Mpgl py . : 
F= i} (6, — 3p sin a,- Fi sin i.) 


(C.2) 





Mg& Mnglp \ >» A 
= ( sh + Maple Vi oss, + J,7 94, 


+ (m gi + MpgLl py) cos @, 


Figure 49 illustrates the block diagram elements which are added to the F equation 
inorder to revise the Flexible Body Model overall system equations. By setting mass 
equal to zero (for no added mass) these terms do not effect the simulation of the plant. 
See Figure 4 for a block diagram of the F equation. 

For the special case of the Rigid Body Model, the F equation (Equation 4.9) is 


modified as shown: 


F = mgcos8 + MpgLpcosé (C.3) 
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Figure 49. 


See Figure 7 for a block diagram of the Rigid Body Model F equation with the place- 
ments of the added mass terms. 
B. DAMPING 

Damping is considered in both the Flexible Body Model and the Rigid Body Model. 


The following term is added to equations 3.4, 3.5, and 3.7 


kIeJy 
G, + JG) ea) 


Damping = C(65) 
5 = (4, — bn) 


(C.5) 


in order to observe the performance characteristics of the two models with and without 


damping. See Figure 50 for a block diagram of the damping term. 
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APPENDIX D. STATE OBSERVER DERIVATION 


A. BACKGROUND 


A dynamic system can be represented in state-space form by the following equation: 


xX = Ax + bu (D.1) 


A control law of 


u= —Gx 
(D.2) 
(A — bG)x 


>: 
I 


can be assumed if ‘x’ is accessible for measurements. But instead of being able to 


measure the state ‘x’, one can only measure 
va ex (D3) 


where the dimension m of the observation vector y 1s less than the dimension of x 
[Ref. 9: p.260]. 

Errors inevitably will be present in the measurement of y(t). These errors mean only 
an estimate for x(r) of x(t) can be made and never x(t) itself. [Ref. 13] 

A better procedure for obtaining an estimate of x(z) is to make the estimate, the 


output of a dynamic svstem. 
k= AX + Bu + Ky (D.4) 


The svstem is excited bv ‘y’ and input ‘u’. By selecting the matrices A,B , and K, the 


error can be made equal to 
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or (D.5) 
K=x—X 
Let a differential equation be equal to 
é = (A — KCe (D.6) 
where 
ky 
k, 
K = 
(D.7) 
ky 
C= [Cer ee 


{Ref. 9: pp. 260-261]. 


Pole placement is to place poles of the feedback system at desired locations. Assume 
Lo aa (D.8) 
are desired eigenvalues, and the characteristic polynomial is 
SS SaaS sea, (D.9) 
In other words, pole placement lets 


[SA = Gi) = S) a) seme ey ee a (D.10) 
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multiple input multiple output systems, G has | x k unknowns ( 1 1s the number of in- 


puts). The solution of G is not unique. Next a matrix N will be defined as 


N =G@eeeG..., A’ GC! 


(D.11) 
C’ = transpose of matrix C 
Matrix “W’ equals 
Pa, . ayy 
Wo = 0 alae (D.12) 
Oe ] 
Now a term K’‘ will be defined as 
K' = (a—a\(NW)"' (D.13) 
Minere 
a= landed 
fa; a). . a, ol® 


a terms are the desired coefficients of the characteristic polynomial. ‘a’ coefficients are 


obtained from the ITAE criteria for a third order equation since ‘a’ is a 1 x 3 matrix. 


B. OBSERVER FOR FLEXIBLE JOINT ROBOT 


The system in this research will be described by the following state space represen- 


a ee ee 
= - u + (D.15) 
X) Ay, Ag | X2 B, 2 
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tation: 


Now make the following relationships: 


Z) — g 
Z) = 6 a} 7 “2 
cope) = v2 (D.16) 
23 = 8 ; 
Si ee 
Z4 — 8 
From Equation (4.3) 
: _ eae _ =e = oe 
2, = 9 = Tha T Tap ig (D.17) 
Xx, = {Zz} = {8} 
Z> g 
X = he = g 
Z4 g 


Substituting values into equation (D.15), results in the following equation: 


Z 01 0 0jlz, 0 0 
Zz GeO. Onli. 0 0 
= + i f (D.18) 
2 00011] 2, 0 0 
. 





| 2s | }0 00 0]]z, hrs | att 


Referring back to equation (D.15), 


A,,;isal x1 matrix 
A,,isalx3 matnx 
A>,1sa3x1 matrix 
A> 18a 3x3 matrix 


9] 


Expanding equation (D.15) results in the following 


NG) = A xX) + A+1X) + Bou 4s th 


: D.19 
— fi + & — AyX, — Byu = Ajox, ( 
An observer is designed as 
X. = AgX, + [A2)X, + Bou + fh] 
y= Cx, 
where a — aes ti - X, fae Aix) eas Bu (D.20) 
CG = Aj 
Redefining equation (D.19) results in 
Oe eG, oo ae 
2 | 2242 21%) 2 Sh ; (D.21) 
+ LIX, — AyX; — Buu — fp — AjoXo] 
iL — X> aoe a 
(Diz) 


X= [A — LA] x, 
As ‘t’ 3 00 X, 7 0. 


C. NUMERICAL SOLUTION 


Using the values provided in equation (D.18), the solution to equation (D.10) is 


is) = Alas ene 


(D238) 
aj =0 a,=0 a, =0 


where 


oO 
C’ =) |GreAC =SerOnn0) 
0 (eAecO 


From equation (D.11) and equation (D.12) 


1 0 0 1 0 0 
Ne 1-0) ane NW=10 1 0 
Oe 00 1 
aaa OG) 
INV(NW) = ]0 1 0 
00 1 
a = (a), a, a3] 


The coefficients for the a, terms were selected from the ITAE criteria table for a 


third order characteristic equation. The values selected were a, = 1.75w,, 


A 


a, = 2.15w?, a, = 1.0w?. [Ref. 8: pp. 129-130]. Equation (D.13) now equals 
K' = [1.75w, 2.15%, 1.000%] 


Looking back at equation (D.21), let K = L. 


A block diagram of the observer is shown in Figure 8 and in Figure 9. 
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APPENDIX E. GRAPHS OF ADDITIONAL SIMULATIONS 


A. GRAPHS WITH NO ADDED MASS 
]. Rigid Body with no load 
The graphs for motor feedback with no damping and a load of 1.36 kg and 
w, = 3 are shown in Figure 51, Figure 52, and Figure 53. 
2. Flexible Body with no load 
The graphs for flexible body with no damping and a load of 1.36 kg and 


w, = 4are shown in Figure 54, Figure 55, and Figure 56. 


B. GRAPHS WITH AN ADDED MASS OF 1.36 KILOGRAMS 
1. Rigid Body Model with Added Mass 
For the examination of the Rigid Body model graphs with damping and added 
mass under going point to point control see Figure 57 and Figure 58 for w, = 1 and 
Figure 59 and Figure 60 for w, = 3. 
2. Flexible Body Model with Added Mass 
For an examination of the Flexible Body Model experiencing point to point 
control and added mass see Figure 61 and Figure 62 for w, = 2 and Figure 63 and 


Figure 64 forw, = 4. 


C. GRAPHS WITH AN ADDED MASS OF 2.5 KILOGRAMS 
1. Rigid Body Model with Added Mass 
For the examination of the Rigid Body model graphs with damping and added 
mass undergoing point to point control see Figure 65 and Figure 66 for w, = 1 and 


Figure 67 and Figure 68 for w, = 3. 
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2. Flexible Body Model with Added Mass 
For an examination of the Flexible Body Model experiencing point to point 
contro] and added mass see Figure 69 and Figure 70 for w, = 2 and Figure 71 and 


mieure {/2forw, = 4. 


D. GRAPHS UNDERGOING TRAJECTORY TRACKING 
1. Rigid Body Model Experiencing Trajectory Tracking 
For the examination of the Rigid Body model graphs with and without damping 
and added mass, under going trajectory tracking see Figure 73 and Figure 74 for 
w®, = 1. See Figure 75 and Figure 76 for wm, = 1 with damping and added mass. 
2. Flexible Body Model Experiencing Trajectory Tracking 
For the examination of the Flexible Body model graphs with and without 
damping and added mass, under going trajectory tracking see Figure 77 and Figure 78 


forw, = 2. See Figure 79 and Figure 80 for w, = 2 with damping and added mass. 
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Flexible Body Model (small motion) w, = 4 


Figure 72. 
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Figure 73. 
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Figure 74. 
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Rigid Body Model (torque) load w, = 


Figure 75. 
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Figure 76. 
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Flexible Body Model (torque) w, = 2 (ramp) 


Figure 77. 
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Flexible Body Model (small motion) w, = 2 (ramp) 


Figure 78. 
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Flexible Body Model (torque) load w, = 2 (ramp) 


Figure 79. 
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